Self-modulated functional electrical stimulation (SM-FES)